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DESCRIPTION 



APPARATUS AND METHOD FOR JOINT MECHANISM, JOINT APPARATUS, AND 
ROBOT DEVICE AND CONTROL METHOD THEREOF 

Technical Field 

The present invention relates to the joint mechanism control 
apparatus and method, the joint apparatus, the robot device and 
the method for controlling the robot device, and can be 
appropriately applied to, for example, a two-leg walking robot. 

Background Art 

Conventionally, a two-leg walking robot is designed by 
connecting a pair of leg units to a belly unit through a thigh 
joint mechanism. Each leg unit is formed by connecting a thigh 
unit to a lower leg unit through a knee joint mechanism, and by 
connecting a foot unit to the lower leg unit through an ankle 
joint mechanism. 

This two-leg walking robot has an actuator (normally an AC 
(Alternating Current) serve-motor hereinafter referred to as a 
motor) incorporated for a necessary free level for each joint 
mechanism. Each motor of each joint mechanism can be individuall 
driven and controlled such that each leg unit can be driven in a 
predetermined pattern, thereby p~eFf ormT.Trg~a^waiL-ki-ng— ope-r^ 
complete ' robot , 



Q 



In the above described two-leg walking robot, various sensors 
such as a pressure sensor, a tilt angle sensor, an acceleration 
sensor, a micro switch, etc. are provided at an ankle joint 
mechanism or a foot unit. The two-leg walking robot is designed 



to stably walk even on the unleveled ground with tilt or 
convexity/concavity by controlling the direction of the foot units 
such that the reverse surfaces of the foot units can always follow 
the surface of the walkway based on the outputs from the above 
ff\ described sensors in the walking operation. 

m However, when such a sensor is actually provided for the 

03 

ankle joint mechanism and the leg unit, the total weight of an 
entire robot increases by the weight of the sensor. In addition, 
wiring is required to electrically connect the sensors with a 
control system in the robot, thereby causing the problem of a 
complicated configuration of the entire robot. Furthermore, if a 
sensor is mounted, it is necessary to process sensor information 
using software in a control system in the robot, thereby 
complicating the walking control. 



With the conventional 2-leg ywalking robot, for example, as 
shown in Fig. 23, a main contro/l unit 1 for controlling the 
operations of the entire robo^ is connected to each motor 3 (3-1 
through 3-n) through a multi/axis controller 2, and the multi-axis 
controller 2 controls each ymotor 3 in each specific state at a 



control instruction output from the maln"contro-l— uni-t— 1-.— 
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In the above described two-l/g walking robot, three rotation 
drive cables (U phase, V phase, /and W phase) , four rotation 

t position sensor cables (A phaafe, B phase, and Z phase) , and one 
ABS position serial signal geble, that is, a total of seven cables 
4, are required, thereby causing the problem of a complicate 
configuration containing f larger number of wires for the entire 
robot . 




f the Invention 



01 The present invention has been developed to solve the above 

described problems, and aims at providing an apparatus and a 
s method for controlling the joint mechanism capable of simplifying 

p the configuration, a joint apparatus and a robot device and a 

control method thereof, 
g To solve the above described problem, the joint mechanism 

control device according to the present invention includes: 
electric current detection means for detecting an electric current 
value of the drive current of an actuator for driving a joint 
mechanism; and external force torque detection means for detecting 
the level of the torque by an external force applied to the output 
axis of the actuator based on the electric current value detected 
by the electric current detection unit. 

As a result, according to the control device, the external 



force applied to the first' or the second rin1c"can~be~obta-ined- 
without any sensor, etc. Thus, a sensor, etc. for directly 
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measuring the external force can be omitted/ thereby realizing a 
joint mechanism control device with a simple entire configuration. 

In addition, the method of controlling the joint mechanism 
according to the present invention includes: a first step of 
detecting an electric current value of the drive current of the 
actuator for driving a joint mechanism; and a second step of 
detecting the level of the torque by an external force applied to 
the output axis of the actuator based on the detected electric 
current value . 

As a result, in the control method, the external force 
applied to the first or the second link can be obtained without a 
sensor, etc. Thus, a sensor, etc. for directly measuring the 
external force can be omitted, thereby realizing a joint mechanism 
control device with a simple entire configuration of the joint 
mechanism. 

Furthermore, the robot device according to the present 
invention includes: electric current detection means for detecting 
an electric current value of the drive current of an actuator of a 
joint mechanism; and external force torque detection means for 
detecting the level of the torque by an external force applied to 
the output axis of the actuator based on the electric current 
value detected by the electric current ^ detection unit. 

As a result, according to the robot device, the external 
force app lied T*o~ the"* f i rs'tf^ or~t he s e~c o nd^ compo nen t— c an— b e- ob ta-i-ne d~ 
without a sensor, etc. Thus, a sensor, etc. for directly 



measuring the external force can be omitted, thereby realizing a ^' 
robot device with a simple entire configuration. 

Furthermore, the robot device control method according to the 
present invention includes: a first step of detecting an electric 
current value of the drive current of the actuator; and a second 
step of detecting the level of the torque by an external force 
applied to the output axis of the actuator based on the detected 
electric current value. 

As a result, in the robot device control method, the external 
force applied to the first or the second component can be obtained 
without any sensor, etc. As a result, a sensor, etc. for directly 
measuring the external force can be omitted, thereby realizing a 
robot device control method with a simple entire configuration of 
the robot device. 

Furthermore, according to the present invention, the two-leg 
walking robot device includes: an actuator, provided at the ankle 
joint mechanism, for generating the rotation torque at a level 
depending on a drive current; an electric current detection unit 
for detecting the electric current value of the drive current of 
the actuator; an external force torque detection unit for 
detecting the level of the torque generated by an external force 
by the output axis of the actuator based on the electric current 
value detected by the electric current detection unit; and a 
control uni"t^for controTring the actuaTtor based— on" th-e-^de tec tron 
result of the external force torque detection unit such that the 
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torque generated by the external force provided for the output 
axis of the actuator can be removed. 

As a result, the robot device realizes walking without a 
sensor, etc. with good balance on the unleveled ground, thereby 
realizing a robot device with a simple entire configuration. 

In addition, according to- the present invention, the method 
of controlling a two-leg walking robot device includes: a first 
step of detecting the electric current value of the drive current 
of an actuator, provided at the ankle joint mechanism, for 
generating the rotation torque at a level depending on a drive 
% current; a second step of detecting the level of the torque 

: generated by an external force by the output axis of the actuator 

^ based on the detected electric current value; and a third step of 

''"-^ controlling the actuator based on the detection result obtained in 

y 

O the second step such that the torque generated by the external 

force provided for the output axis of the actuator can be reduced. 

As a result, the method realizes a robot device walking 
without a sensor, etc. with good balance on the unleveled ground, 
thereby realizing a method of controlling a robot device with, a 
simple entire configuration. 

Furthermore, according to the present invention, the joint 
device includes a motor unit for generating the rotation torque 
for the actuator; and motor control means, provided in the motor 



unit, for controlling the" drive^ of th"e~motor— unrt— 
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As a result, the joint device can largely reduce the number 
of wires between the actuator and the external devices, thereby 
realizing a simple configuration of the joint device. 

Furthermore, according to the present invention, the robot 
device includes a motor unit for generating the rotation torque 
for the actuator which drives a joint mechanism; and motor control 
means, provided in the motor unit, for controlling the drive of 
the motor unit. 

As a result, the robot device can considerably reduce the 
number of wires connected to each actuator of a joint mechanism, 
thereby realizing a robot device with a simple configuration. 

Brief Description of the Drawings 

Fig. 1 is an oblique view of the configuration of the two-leg 
robot according to the embodiment of the present invention. 

Fig. 2 is an oblique view of the configuration of the two-leg 
robot according to the embodiment of the present invention. 

Fig. 3 shows the concept about the configuration of the two- 
leg robot according to the embodiment of the present invention. 

^^^ ^i - g- T — 4 — jr s a fron t vj - cvj ^ and a side view showing the 
configuration of the thigh joint mechanism. 

^ ^ig . '■■ 5 -""i' 0 ^a— S ^ g@i i a ■ t ^^^ v>L G. w ^ a ' ]a showing the 

configuration of the thigh joint mechanism. 

~~; nri"g. G i^ "d~ bide " vie w , a Iiu nL vi ew* , — and- a~s i de -v-i-e w— s ho w i-n g — 
the configuration of the ankle joint mechanism. 



Fig, 7 is a block diagram showing the internal configuration 
of the two-leg walking robot shown in Fig. 1, 

Fig. 8 is a block diagram showing the electrical connection 
between the sub-control unit and each motor. 

Fig, 9 is a sectional view showing the configuration of each 
motor. 

^^^^y ^ i- g - — 10" s irow-e the outline of the configuration of the rotor 

and the rotor axis magnetic pole angle sensor. 

Fig.. 11 is a partial sectional view showing the positional 

2 relationship between a rotor and a stator iron. core. 

v\ Frq T — — screws- the outline of the configuration of a stator 
C\ ^ >Cj5\ 

" and a power substrate. 

O .^^T^*^"'^ — ^ — Bh^sMs. the outline of the configuration of a torque 
Sf amplification unit. 
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Fig. 14 shows the waveform for explanation of the 
magnetization pattern of a resin magnet of one-turn absolute angle 
sensor. 

Fig. 15 shows the waveform for explanation of the first and 
the second one-turn absolute angle sensor signals. 

^^^jfj^'iy. lU la a piian ""vi^ew- showing the outline of the 
configuration of the control substrate. 

Fig. 17 is a block diagram of the configuration of the 
control substrate . 



Fig. 18 is a block diagram of the con frgur a t-i-on~of^^t'he— power- 
substrate . 
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Fig. 19 is a block diagram of the configuration of a one-chip 
microcomputer. 

Fig. 20 is a block diagram showing the operations process of 
the CPU in the motor rotation control process mode. 

Fig. 21 is a block diagram of the procedure of the rotor axis 
magnetic pole rotation number detecting process. 

Fig, 22 is a flowchart showing the unleveled ground walking 

control procedure. " — ' 

Fig. 23 is a bl/ck diagram showing the connection 
relationship betwe^ each motor and the main control unit of the 
conventional robot/. 



Best Mode for Carrying Out the Invention 

An embodiment of the present invention will be described 
below by referring to the attached drawings. 
(1) Entire Configuration of the Robot according to the 
Embodiments 

In Figs. 1 and 2, a robot 10 indicates a two-leg walking 
robot according to the embodiments. A head unit 12 is positioned 
above a belly unit 11. Arm units 13A and 13B are positioned as 
having the same configurations at each side of the belly unit 11. 
Leg units 14A and 14B are positioned as having the same 
configurations at each lower side of the belly unit 11. 

The b^ll"y""uirit~ri"~i~s^~de'si"gn"Bid^ by~conne"C 

forming the upper portion of a trunk to a hip base 21 forming the 



lower portion of the trunk through a knee joint mechanism 22. The 
upper portion of the trunk of the belly unit 11 can independent 
rotate, by driving motors M-1 and M-2 of the knee joint mechanism 
22 fixed to the hip base 21 at the lower portion of the belly unit 
on a roll axis 23 and a pitch axis 24 which are orthogonal to each 
other as shown in Fig. 3 

The head unit 12 is mounted on the center of a shoulder base 
25 fixed on the top of the frame 20 through a neck joint mechanism 
26/ and can independently rotate, by driving each of the motors M- 
3 and M-4 of the neck joint mechanism 26, on a pitch axis 27 and a 
yaw axis 2 8 which are orthogonal to each other as' shown in Fig. 3. 

Each of the arm units 13A and 13B' is mounted on the left or 
the right of the shoulder base 25 through a shoulder joint 
mechanism 29, and can independently rotate, by driving each of the 
motors M-5 and M-6 of the shoulder joint mechanism 29, on a pitch 
axis 30 and a roll axis 31 which are orthogonal to each other as 
shown in Fig. 3. 

In this case, in each of the arm units 13A and 13B, a motor 
M-8 forming each fore arm unit is connected to the output axis of 
a motor M-7, through an elbow joint mechanism 32, and a hand unit 
33 is attached to the tip of the forearm. 

In each of the arm units 13A and 13B, the forearm unit 
rotates on a yaw axis 34 shown in Fig. 3 by driving the motor M-7, 
and the forearm unit r o t^t es ~o n a pTI: c hT ^xTs~3 5~s h o wn ~i n~F rg:; — 3— by 
driving the motor M-8. . 
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On the other hand, each of the leg units 14A and 14B is 
mounted to the hip base 21 below the belly unit through a thigh 
joint mechanism 36, and can independently rotate on a yaw axis 37 
a roll axis 38 and a pitch axis 39 orthogonal to each other as 
shown in Fig. 3 by driving each of the motors M-9 through M-11 of 
the corresponding thigh joint mechanism 35. 

In this case, in each of the leg units 14A and 14B,- a frame 
42 forming a lower leg unit is connected to the lower end of a 
frame 40 forming a thigh unit through a knee joint mechanism 41, 
and a foot unit 44 is connected to the lower end of the frame 42 
through an ankle joint mechanism 43. 

Thus, in each of the leg units 14A and 14B, the lower leg 
unit can rotate on a pitch axis .45 shown in Fig. 3 by driving a 
motor M-12 forming part of the knee joint mechanism 41, and the 
foot unit 44 can independently rotate on the pitch axis 45 and a 
roll axis 46 orthogonal to each other as shown in Fig. 3 by 
driving motors M-13 and M-14 of the ankle joint mechanism 43 
respectively. 



shJw 



Figs. 4 and 5 shcfw the configuration of the thigh joint 
_ 3 /obot 10, 
joint mechahi; 



mechanism 36 of the jfobot 10, and Fig. 6 shows the configuration 
of the ankle joint rfiechahism 43 

As shown in Figs. 4^and 5, the motor M-9 is fixed to the hip 
base 21 at the lower portion of the belly unit in the thigh joint 
"me^RanTsm ~3"6T TEe "oiltnut "~axi s ~o f ~ t"h"e^ moto r^M'^*l"0— i s~conne c ted— to — 
the output axis of th^ motor M-9 through a U-shaped connection 
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'ft 1^ .material 50, and a yf-shaped material 51 is fixed to the side of 
pjrthe motor M-10. 



In addition, a joint mechanism pulley 52 is connected to the 
U-shaped material 51 as freely rotating thereon, and the frame 40 
forming part of the thigh unit in the leg units 14A and 14B is 
provided with one upper end of the U-shaped material 51 fixed to 
the joint mechanism pulley 52, and the other end attached to the 
Q U-shaped material 51 as freely rotating thereon. 

0=1 The motor M-11 of the thigh joint mechanism 36 is fixed to 

^ the frame 40, and a pulley 53 attached to the output axis of the 

03 

^ motor M-11 is connected to the joint mechanism pulley 52 through a 

-H 

timing belt 54 . 

Thus, in the thigh joint mechanism 36, the corresponding leg 

Q 

units 14A and 14B can independently rotate on the yaw axis 37, the 
roll axis 38, and the pitch axis 39 by driving each of the motors 
M-9 through M-11 . 

In this embodiment, the yaw axis 37 passing through the 
center of the output axis of the motor M-9 of the thigh joint 
mechanism 36, the roll axis 38 passing through the center of the 
output axis of the motor M-10, and the pitch axis 39 passing 
through the rotation center of the frame 40 are positioned such 
that they can cross at one point in the space. 

In the ankle joint mechanism 43, as shown in Fig. 6, the 



output axis of the motor M-14 is fixed to a U-shaped~"connect"ion-- 
material 60 fixed to the foot unit 44. A joint mechanism pulley 
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62 is fixed to the side of the motor M-14 through a U-shaped 
material 61, 

The frame 42 forming part of the lower leg unit of the above 
described leg units 14A and 14B is mounted with one lower end 
connected to the center o£ the joint mechanism pulley 62 as freely 
rotating, and with the other lower end connected to the side of 
the U-shaped connection' material 61 as freely rotating, 
p In addition, the motor M-13 is fixed to the frame 42, a 

gi pulley 63 is fixed to the output axis of the motor M-13, and the 

P pulley 63 and the joint mechanism pulley 62 are connected with 

£ each other through a timing belt 64. 

Thus, in the ankle joint mechanism 43, the foot unit 44 can 
independently rotate on the roll axis -45 and the pitch axis 4 6 by 
driving each of the motors M-13 and M-14. 

On the other hand, in the robot 10, a control unit 72 is 
provided as storing in a box a main control unit 70 for 
controlling the entire operation of the robot 10, a peripheral 
circuit 71 such as a power supply circuit, a communications 
circuit, etc., a battery not shown in the attached drawings, and 
so forth on the back of the hip base ,21 forming the lower part of 
the belly unit 11 as shown in Fig. 7. 

The control unit 72 is connected to each of sub-control units 
73A through 73D provided in each configuration unit (the belly 



Lie 
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unit 11, the head unit r2, each of the arm uni"ts~l"3-A— and~i~3B, — and — 
each of the leg units 14A and 14B) so that a necessary power 
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supply voltage can be provided for the sub-control units 73A 
through 73D and the control unit 72 can coininunicate with the sub- 
control units 73A through 73D. 

In addition, the sub-control units 73A through 73D are 
connected in parallel to the motors M-1 through M-14 in the 
corresponding configuration unit as shown in Fig, 8 through two 
drive voltage supply cables 80, two control voltage supply cables 
81, and one simultaneous clock supply cable 82, and are connected 
to each control substrate stored in each of the motors M-1 through 
M-14 in the daisy-chain system through two serial communications 
cables 83. Further, Fig. 8 shows the connection between the sub- 
control unit 74D in each of the leg units 14A and 14B and each of 
the motors M-9 through M-14. 

At this time, the main control unit 70 stores, as the 
rotation angle of the output axis of each of the motors M-1 
through M-14, the form in each state of the robot 10 such as 
'standing state,' 'sitting state,' etc., and the forms in time 
series at predetermined time intervals (for example, 0,5 second to 
be hereinafter referred to as a first time interval) when the 
robot 10 is changing its state, and when the robot 10 performs a 
predetermined operation such as a walking operation, etc. 

When the main control unit 70 makes the robot 10 change its 
state, perform an operation, . etc . , it switches in time series for 

earchr^f~~tR^~f irs"t^tT-lne ~11T ^angle— of— the— output 

axis of the motors M-1 through M-14 in each of the stored forms in 



serieS/ and then transmits the result to the corresponding sub- 
control units 74A through 74D, 

On the other hand, each of the sub-control units 74A through 
74D provides a power supply voltage for driving a motor and a 
control voltage for each of the corresponding motors M-1 through 
M-14 based on the power supply voltage supplied by the control 
unit 72 respectively through the drive voltage supply cable 80 and 
the control voltage supply cable 81. 

Each of the sub-control units 74A through 74D computes the 
rotation angle, the rotation speed, or the rotation torque of each 
of the corresponding motors M-1 through M-14 at each timing (1 
[ms] interval in this example) when the first time interval is 
equally divided into n (n is an integer equal to or larger than 2) 
from the rotation angle of each of the motors M-1 through M-14 
assigned as described above at the first time interval from the 
main control unit 70, and controls each of the motors M-1 through 
M-14 based on the computation result. 

As described above, in the robot 10, the drive of the motors 
M-1 through M-14 is controlled such that the form of the robot 10 
being operated can sequentially match each of a time series of 
forms stored in the main control unit 70, and that various 
operations can be performed with predetermined movement or changed 
into various states* 

C2) Con^Tc^ur^"tTbh~b^^ 

(2-1) Entire configuration of motors M-1 through M-14 



Described below is the configuration of each of the motors M- 
1 through M-14 used in the robot 10. Each of the motors M-1 
through M-14 of the robot 10 comprises, as shown in Fig. 9, a 
motor unit 90 for generating the rotation torque, and a torque 
amplification unit 91 for amplifying the rotation torque generated 
by the motor unit^ 90 and outputting the amplified torque 91. 

In this case, in the motor unit 90, a rotor axis 94 is 
.3 provided and supported as freely rotating on rotation bearings 93A 

g«l and 93B in a motor case 92. A rotor 97 is formed by designing the 

£t 

rotor axis 94 sharing the same axis with a rotor base unit 95, and 

03 

^ a ring-shaped rotor magnet 96 magnetized to four poles as shown m 
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Figs. 10 (B) and 10 (C) . 

In the motor case 92, as shown in Figs. 8 and 9A, six stator 
iron cores 98A through 98F are fixed at equal intervals (60 [°] 
intervals) as surrounding the rotor 97, and each of the stator 
iron cores 98A through 98F is wired to form coils 99A through 99F. 

In the motor unit 90, two 180 [°] opposing coils 99A and 99D, 
99B and 99E, and 99C and 99F (three sets in all) are respectively 
set as a U phase, a V phase, and a W phase. The rotor 97 can be 
rotation-driven by applying to each of the coils 99A through 99F 
in the U phase, the V phase, and the W phase a drive current with 
the phase 120 [°] shifted from each other, thereby generating the 
rotation torque. 



On the other hand, the torque^ amp"l-i"f±er"91— has— a— gear— case 

100 fixed at the end of the motor case 92 as freely removable as 
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shown ■ in Fig. 9 and Figs. 13A through 13C. The gear case 100 
contains a circular internal gear 101, a sun gear 102 fixed at the 
end of the rotor axis 94, and a planet gear mechanism 104 
comprising the first through the third planet gears 103A through 
103C arranged at 120 [ ] intervals between the internal gear 101 
and the sun gear 102. 

At this time, in the torque amplification unit 91, each of 
axes 105A through 105C of the first through the third planet gears 
103A through 103C in the planet gear mechanism 104 is fixed to an 
output axis 106 arranged as freely rotating at the end of the gear 
case 100. With the configuration, the rotation torque provided 
from the motor unit 90 through the rotor axis 94 is transmitted to 
the output axis 106 through the planet gear mechanism 104, and 
then externally output through the output axis 106. 

The torque amplification unit 91 also comprises a one-turn 
absolute angle sensor 109 comprising a circular resin magnet 107 
fixed to the output axis 106, and the first and second hole 
elements 108A and 108B fixed to the surface of the gear case 100 
such that they can face the surface of the resin magnet 107. 

In this case, the resin magnet 107 is magnetized such that 
the magnetic flux density (t)(9g) can be changed for two poles and a 
round as shown in Fig. 14, and is fixed to the output axis 106 as 
shown in Fig. 13(A), In addition, the first and second hole 

"e"Ieniehrts"~r0 8Ar~and~r0 8B"~afe^ 

100 with the phase difference of 90 [°] as shown in Fig. 13(B). 
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Thus, the one-turn absolute angle sensor 109 detects the 
rotation angle of the output axis 106 as a change of the magnetic 
flux density (j) (Gg) at the arrangement position of the first and 
second hole elements 108A and 108B associated with the rotation of 
the output axis 106, and the detection result can be output as 
first and second one-turn absolute anglie sensor signal SIA and SIB 
of a waveform provided by sin (9g). and cos (9g) as shown in Fig. 
15 from the first and second hole elements 108A and 108B. 

In addition to the above described configuration, the motor 
case 92 of the motor unit 90 contains the rotor axis magnetic pole 
angle sensor 100 for detecting the magnetic pole angle of the 
rotor axis 94, a control substrate 111 for controlling the 
rotation angle, the rotation speed, and the rotation " torque, etc. 
of the output axis 94 according to the control command from the 
corresponding sub-control units 74A through 74D, and a power 
substrate 112 for supplying a drive current for each of the coils 
99A through 99F of the motor unit 90 under the control of the 
control substrate 111. 

A rotor axis magnetic pole angle sensor 110 comprises a resin 
magnet 113 fixed to the front end of the rotor base unit 95 of the 
rotor 97, and the first through fourth hole elements 114A through 
114D mounted onto the control substrate 111. The resin magnet 113 
is magnetized for the four poles as the rotor magnet 96 of the 
Yo tor ~9~7 as "sfic)v7rr~ih~Fi"gs . TO ( B") and^ro ( C")"7 ' and" ~i-s -f ixed- to— the — 
rotor base unit 95 with the same phase as the rotor magnet 96. 



The first through fourth hole elements ^114A through 114D are 
mounted onto the control substrate 111 such that the first and 
second hole elements 114A and 114B face each other at 180 [°] on 
the concentric circle -with the rotor axis 94, and the third and 
fourth hole elements 114C and 114D are positioned with the phase 
shifted by 45 [°] in the same direction as the first and the 
second hole elements 114A and 114B as shown in Fig. 16(B). 

Thus, in the rotor axis rotation angle sensor 110, the 
magnetic pole angle of the rotor axis 94 can be detected as a 
change of the magnetic flux density with the arrangement of the 
first through fourth hole elements 114A through 114D associated 
with the rotation of the resin magnet 113 rotating with the rotor 
axis 94. 

The magnetic pole angle of the rotor axis 94 refers to the 
angle obtained by multiplying the mechanical rotation angle of the 
rotor axis 94 by the half number of the magnetic poles of the 
rotor magnet 96. In this embodiment, since the rotor magnet 96 is 
magnetized for four poles, the magnetic angle ranges from 0 to 2n, 

On the other hand, the control substrate 111 is configured by 
loading a one-chip microcomputer 115 and a crystal oscillator 116 
for generation of a CPU clock onto one side of a print wiring 
board, and by loading the first through fourth hole elements 114A 
through 114D of the above described rotor axis rotation angle 

"sens6r~riO~^hxi~ar~tem^eratOT -as 

shown in Figs. 9, 10(A), 16, and 17. 



Scat 



As shown in Fig. 17, the control substrate 111 adds up the 
outputs from the first and the second hole elements 114A and 114B 
and the outputs from the third and fourth hole elements 114C and 
114D of the rotor axis magnetic pole angle sensor 110 through 
first and second subtraction circuits 118A and 118B, fetches them 
as first and second rotor axis magnetic pole angle sensor signals 
S2A and S2B into the one-chip microcomputer 115, and fetches first 
and second 1-turn absolute angle sensor signals SIA and SIB 
provided from the one-turn absolute angle sensor 109 (Figs. 9 and 



y= ' 13(C)) through a cable 119 (Fig. 9) into the one-chip 
^ microcomputer 115. 

s The control substrate 111 is connected to the corresponding 

sub-control units 74A through 74D (Fig. 8) through two control 
SI power supply lines and two drive power supply lines contained in a 

Q second cable 120. Thus, the one-chip microcomputer 115 can fetch 

each type of power supply voltage through the second cable 120, 
^ and communicate with the corresponding sub-control units 74A 
through 74D. 

The one-chip microcomputer 115 computes the value 
(hereinafter referred to as first through third electric current 
command values) of the drive current to be applied to each of the 
coils 99A through 99F in the U, V, and W phases according to the 
specified values (hereinafter referred to a specified rotation 

ahgre , a speci~f Ted' ro"t a tio n s pee dy ^and~~a~~spe'crf red-rotation— 

torque) of the rotation angle, the rotation speed, and the 
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rotation torque of the output axis 106 (Fig. 9) provided from the 
sub-control units 74A through 74D through the second cable 120 for 
1 [ms] ; the first and second 1-turn absolute angle sensor signals 
SIA and SIB; the first and second rotor axis magnetic pole angle 
sensor signals S2A and S2B; and first through third drive current 
detection signals S3A through S3C provided from the power 
substrate 112 as described later, and then outputs the computed 

□ first through third electric current command values to the power 

01 substrate 112 through a third cable 121. 

01 The power substrate 112 is configured by mounting a plurality 

£ of power transistor chips 123 forming a coil drive block 122 shown 

■h 

=5 ' in Fig. 18 on one side of the circular printed substrate as shown 

Mi 

p in Figs. 9, 12(B), and 12(C). 

i The coil drive block 122 rotation-drives the rotor 97 of the 

i , motor unit 90 by applying the drive current, whose level depends 

on the corresponding the first through third electric current 
command values, to each of the coils 99A through 99F in the U, V, 
and W phases of the motor unit 90 based- on the first through third 
electric current command values provided from the one-chip 
microcomputer 115 of the control substrate 111. 

At this time, the coil drive block 122 detects the level of 
the drive current applied to each of the coils 99A through 99F in 
the U, V, and W phases, and transmits the detection results to the 
corrtrb"l su&s^tTa"t"e~ 1 rr~thr'ough~th^e~thi-rd— cabl-e^— — (-Fi-g-. — 9) — a-s— t-he — 
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first through third drive current detection signals S3A through 
S3C. 

Thus, the motors M-1 through M-14 are designed to drive the 
motor unit 90 based on the specified, rotation angle, the specified 
rotation speed, or the specified rotation torque provided from the 
sub-control units 74A through 74D through the control circuit 
comprising the one-chip microcomputer 115 of the control substrate 
111 and the coil drive block 122 of the power substrate 112. 
(2-2) Configurations of the one-chip microcomputer 115 and the 
coil drive block 122 

The one-chip microcomputer 115 comprises, as shown in Fig. 19, 
an arithmetic operations block 128, a register 129, a rotor axis 
rotation angle detecting block 130, a torque-3-phase electric 
current signal converting block 131, an electric current 
controlling block 132, and first through fourth analog/digital 
conversion circuits 133 through 136. 

The one-chip microcomputer 45 digital-converts in the first 
analog/digital conversion circuit 133 the first through third 
drive current detection signals S3A through S3C provided from the 
power substrate 112, and provides obtained first through third 
drive current detection data D3A and D3B for the electric current 
controlling block 132, and stores the first through third drive 
current detection data D3A and D3B in the register 129. 

Ifr^7adit"i"on7 "th"e^one^chip~mrcrocomputer — l-l-5~digi-ta-l-- — 
in a third analog/digital conversion circuit 135 the first and 



second 1-turn absolute angle sensor signals SIA and SIB provided 
from the one-turn absolute angle sensor 109 (Figs. 9 and 13(C)), 
and stores the obtained first and second 1-turn absolute angle 
sensor data DIA and DIB in the register 129. 

Furthermore, the one-chip microcomputer 115 digital-converts 
in a second analog/digital conversion circuit 134- the first and 
second rotor axis magnetic pole angle sensor signals S2A and S2B 
based on the output from the rotor axis magnetic pole angle sensor 
110 provided from the first and second subtraction circuits 118A 
and 118B (Fig. 17), and inputs the obtained first and second rotor 
axis magnetic pole angle sensor data D2A and D2B to the rotor axis 
rotation angle detecting block 130. 

The rotor axis rotation angle detecting block 130 detects a 
magnetic pole rotation angle (hereinafter referred to as a rotor 
axis magnetic pole rotation angle) Pj^i of a rotor axis 24, and a 
magnetic pole angle 9p according to the provided first and second 
rotor axis magnetic pole angle sensor data D2A and D2B, stores the 
rotor axis rotation angle F^^ in the register 129, and transmits 
the magnetic pole angle 0p to the torque-3-phase electric current 
signal converting block 131. 

The magnetic pole rotation angle of the rotor axis 94 (rotor 
axis magnetic pole rotation angle P^i) refers to the angle at which 
a change in the magnetic poles in a pair of the adjacent N and S 
poTes"' oT " the ~ r esTrr"m"a gn"e t~rr3~de te'c t ed" b y— t h e— f rr s t- t-h-r ough -f ou-^r-th- 
hole elements 114A through 114D with the rotation of the rotor 



axis 94 can be defined as one cycle (0 through 2n) . Since the 
resin magnet 113 is magnetized for four poles in the present 
embodiment, the rotor axis magnetic pole rotation angle F^^ ranges 
from 0 to 47t. 

The arithmetic operations block 128 obtains a target rotation 
torque Tq according to the first and second 1-turn absolute angle 
sensor data DIA and DIB and the rotor axis magnetic pole rotation 
angle F^^ stored in the register 129, and the specified rotation 
angle, the specified rotation speed, or the specified rotation 
torque provided from the sub-control unit, and stores the 
operations result in the register 129. The target rotation torque 
To is computed for 1 [ms] provided the specified rotation angle, 
the specified rotation speed, or the specified rotation torque 
from the sub-control unit. 

The target torque . Tq is read from the register 129 one after 
another by the torque-3-phase electric current signal converting 
block .131. The torque-3-phase electric current signal converting 
block 131 computes the above described first through third 
electric current command values Ur, Vr, and Wr indicating the 
values of drive currents to be applied to each of the coils 99A 
through 99F in the U, V, and W phases in the motor unit 90 based 
on the target torque Tq, and the magnetic pole angle 9p of the 
rotor axis 94 provided from the rotor axis rotation angle 
ci e tec t~iTi g"~b"l o^c ]^ 1 307 an 

electric current controlling block 132. 



The electric current controlling block 132 performs a 
predetermined signal process containing a compensating process for 
a voltage, change on the first through third electric current 
command values Ur, Vr, and Wr based on the first through third 
electric current command values Ur, Vr, and Wr provided from the 
torque-3-phase electric current signal converting block 131, and 
the first through third drive current detection data D3A through 
D3C provided from the first analog/digital conversion circuit 133. 
Then, the electric current controlling block 132 PWM (Pulse Width 
Modulation) modulates the result., and transmits the obtained first 
through third PWM signals S4A through S4C to the coil drive block 
121 of the power substrate 112 through the third cable 121. 

The third cable 121 is provided with two lines for each of 
the first through third PWM signals S4A through S4C, When the 
output axis 106 (Fig. 9) is driven for normal rotation, the 
electric current controlling block 132 transmits the first through 
third PWM signals S4A through S4C to the coil drive block 122 of 
the power substrate 112 through a first line, and transmits logic 
'0' level signals (hereinafter referred to as first through third 
reference signals) S5A through S5C in the first through third PWM 
signals S4A through S4C to the coil drive block 122 of the power 
substrate 112 through a second line. 

When the output axis 106 is driven for inverse rotation, the 
e"lecf^ic"~cur3rehrt "con f i-rst— through- 

third PWM signals S4A through S4C to the coil drive block 122 of 



the power substrate 112 through the second line, and transmits the 
first through third reference signals S5A through S5C to the coil 
drive block 122 of the power substrate 112 through the first line. 

On the other hand; as shown in Fig, 18, the coil drive block 
122 contains, corresponding to the coils 99A through 99F in the U, 
V, and W phases, first through third gate drive circuits 139A 
through 139C having the same configurations each containing four 
amplifiers 138A through 138C, and first through third inverter 
circuits 140A through 140C having the same configurations each 
comprising two PNP-type transistors TRl and TR2 and two NPN-type 
transistors TR3 and TR4 . 

In the coil drive block 122, the first line of each of the U, 
V, and W phases is connected to the bases of the second PNP-type 
transistor TR2 and the first NPN-type transistor TR3 of the; first 
through third inverter circuits 140A through 140C through the 
first and third amplifiers 138A and 138C of the corresponding 
first through third gate drive circuits 139A through 139C. The 
second line of each of the U, V, and W phases is connected to the 
bases of the second PNP-type transistor TR2 and the first NPN-type 
transistor TR4 of the first through third inverter circuits 140A 
through 140C through the second and fourth amplifiers 138B and 
138D of the corresponding first through third gate drive circuits 
140A through 140C. 

Irr~the"~co"rr~dri"ve^b"roc"k~r2"2";^ — ea~ch~o-f~the- -col-is— 99A -th-r-ough 

99F in the U, V, and W phases in the motor unit 90 is connected 



between the central point of the connection between the collector 
of the first PNP-type transistor TRl and the collector of the 
first NPN-type transistor TR3 in the first through third inverter 
circuits 140A through 140C, and the central point of the 
connection between the collector of the second PNP-type transistor 
TR2 and the second NPN-type transistor TR4 . 

In the coil drive block 122, the first through third PWM 
signals S4A through S4C provided through the first or the second 
line are converted into drive currents 1^, Iv/ ^nd in an analog 
waveform in the corresponding first through third inverter 
circuits 140A through 140C for each of the V, and W phases, and 
are applied to respective coils 99A through 99F in the 
corresponding U, V, and W phases. 

In the coil drive block 122, the levels of the drive currents 
I^, I^, and I„ provided for the coils 99A through 99F in the U, V, 
and W phases are detected by an electric current sensor 141 
comprising the coils provided in the first through third inverter 
circuits 140A through 140C, and the detection result is 
transmitted to the first analog/digital conversion circuit 133 
(Fig. 19) of the one-chip microcomputer 115 of the control 
substrate 111 as the above described first through third drive 
current detection signals S3A through S3C. 

The detailed configuration of the arithmetic operations block 
T 2'8~T s*~d e"s c ri" bed~be lo w~b y ^re f er r i n"g~ t o' ~F rg .—^1-9^.^ 



The arithmetic operations block 128 comprises a CPU (Central 
Processing Unit) 148, a ROM (Read Only Memory) 149 storing various 
programs, a RAM (Random Access Memory) 150 as the work memory of 
the CPU 148, a serial communications input/output circuit 152 
which is an input/output interface circuit to and from the 
corresponding sub-control units 73A through 73D, a servo- 
interruption signal generation circuit 153 for generating a servo- 
interruption signal SIO of a 1 [ms] cycle for servo-interruption 
and a PWM pulse signal Sll of a 50 [\xra] cycle which is a PWM cycle, 
and a watch dog signal generation circuit 154 for generating a 
watch dog signal S12 having a predetermined cycle longer than 1 
[ms] cycle for the CPU 148 detecting whether the servo- 
interruption signal SIO is correctly generated from the servo- 
interruption signal generation circuit 153. These components are 
interconnected through a CPU bus 155. 

When a control voltage (5 [V]) is supplied by the 
corresponding sub-control units 73A through 73D, the CPU 148 first 
performs the initial processes for various initial values, 
parameter settings, etc. on the serial communications input/output 
circuit 152, the counter timer control circuit 153, the rotor axis 
rotation angle detecting block 130, the torque-3-phase electric 
current signal converting block 131, the electric current 
controlling block 132, etc. based on the initial program stored in 



Furthermore, based on the servo-interruption signal SIO 
provided from the counter timer control circuit 153 obtained as a 
result of the above described processes, and the corresponding 
program stored in the ROM 149, the CPU 148 executes a motor 
rotation control op,erations process for generating the above 
described target rotation torque Tq, a serial communications 
control process to and from the corresponding sub-control units 
73A through 73D on a 1 [ms] cycle in a time-divisional manner. 
(2-3) Software process 

In the arithmetic operations block 128, the CPU 148 executes 
the motor rotation control operations process, the serial 
communications control process, etc. on l[ms] cycle in a time- 
divisional manner based on the servo-interruption signal SIO 
provided from the counter timer control circuit 153, and the 
corresponding program stored in the ROM 149. Described below is 
the process of the CPU 148 in the process mode for the above 
described operations . 

(2-3-1) Process of the CPU 148 in the motor rotation control 
operations process mode 

The process of the CPU 148 in the motor rotation control 
operations mode is performed to compute the target rotation torque 
To according to the designation of the value -of the specified 
rotation position, the specified rotation speed, or the specified 

ro^fa tib o rqu e ~as signed— for ~1" [ ms"]^ b y — t he- ab o ve- de s c r-i-b e d 

corresponding sub-control units 73A through 73D. 



m 



The CPU 148 computes the target rotation torque Tq by 
computing the rotation position of the output axis 94 (Fig. 9) 
based on the rotor axis magnetic pole rotation angle Pj^i stored in 
the register 129 by the rotor axis rotation angle detecting block 
130 when the specified rotation position P^^f is provided from the" 
corresponding sub-control units 73A through 73D^ by computing the 
target rotation speed V^^^^f for the specified rotation position P^^^ 
and the current rotation speed V^^ of the output axis by computing 
the rotations using the rotation position P„ by the following 
Equations (1), and {2), and then by performing the following 
Equation (3) based on the above described Equations. 



Vmref = (Pref - Pm) x Kpp 



... (1) 



--I 

s 



Vm = Pm X S 



... (2) 



TO = Uvmref 



1 r Kvi 
Vm] X 1 + 

L s . 



X Kvp 



(3) 



When the . specif ied rotation speed V^^f is provided from the 
sub-control units 73A through 73D, the current rotation speed of 
the output axis 94 is computed by the Equation [2), and the target 
rotation torque Tq is computed by performing the operation by the 
~f o rrolrtT ing' ~E"qu a tlTo n ("4") ^b as'ed "~o n~" t he r o ta tro n— s p e e d— V^-^;^ 
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TO = J[Vref - Vm] 



Kvi 
1 + 



X Kvp , , , (4) 



When the specified rotation torque T^^f is provided from the sub- 
control units 73A through 73D, it is used as is as the target 
rotation torque Tq. 

In these Equations (1) through (4), S indicates a Laplace 
operator, Kpp, K^i, and K^p indicates control gain parameters set by 
^ the sub-control unit. By changing the values of the control gain 

^ parameters Kpp, K^^, and K^p, the answers of the motors M-1 through 

M-14 in response to the specified rotation angle P^^f and the 
==P specified rotation speed V^^^ can be changed. 

^ Fig. 20 shows the practical process procedure ofc the CPU 148 

Q in the motor rotation control operations process mode. 

SJ The CPU 14 8 computes the number of magnetic pole rotations 

O 

□ (hereinafter referred to as the number of rotor axis magnetic pole 

rotations) N^^ of the rotor axis 94 based on, the first and second 
absolute angle sensor data DIA and DIB stored in the register 129 
when the specified rotation angle P^-e^ is provided from the sub- 
control units 73A through 73D (step SPl) . 

The number of rotor axis magnetic pole rotations is defined 
as the number or rotations each indicating a change of a magnetic 
flux at a pair of adjacent N and S poles of the resin magnet 113 
detected by the first through fourth hole elements 114A through 
ri"4D~"of ~t h e~~r" D'tor a x i"s ma~gn~e' t i"c p"oi."e"~a^ ns or — 1-1-0^ - wi-th -t-h e 



rotation of the rotor axis 94, According to the embodiment, since 
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the resin magnet 113 is magnetized for four^ magnetic poles, the 
number of rotor axis magnetic pole rotations N^^ is 2 when the rotor 
axis 94 mechanically makes one turn. 

Then, the number of rotor axis magnetic pole rotations 'N^ can 

be obtained as follows. First, the phase 0g of the first and 
second 1-turn absolute angle sensor signals SIA and SIB 
respectively represented by sin 0g and cos 9g is computed 
according to the rotor axis magnetic pole rotation number 
detecting procedure shown in Fig. 21 in the software process based 
on the first and second absolute angle sensor data DIA and DIB 
stored in the register 41 (step SPIA) . The phase 9g is multiplied 
by the gear ratio N of a planet gear mechanism unit 16 of a torque 
amplification unit 3 (step SPIB) . The multiplication result is 
divided by 27C, and the integer portion of the division result is 
multiplied by a half value Np of the number of magnetic poles (4 
according to the present embodiment) of the resin magnet 113 of 
the rotor axis magnetic pole angle sensor 110 (Fig. 9) (step SPIC) . 

In addition, the CPU 148 computes the rotation angle P^^ of the 
output axis 106 by performing the operation by the following 
Equation (6) using the P^o obtained by the following Equation (5) 
as an initial value based on the number of rotor axis magnetic 
pole rotations computed as described above and the rotor axis 
magnetic pole rotation angle data P^^i stored in the register 129 as 
shown i"n" "F i"g^ 20 ("s't e p~ ~S P 2")~." ^ 
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PitiO = 27i: X Nm 



. . (5) 



Pm = PmO X Pml 



(6) 



'5 
01 

m 
O 



Then, the CPU 148 detects the error P^ (hereinafter referred 
to as a rotation angle error) for the specified rotation angle P^ef 
(step SP3) by subtracting this rotation angle P^ from the specified 
rotation angle P^ef 

Then, the CPU 148 computes the target rotation angle V^ref fo^ 
the specified rotation angle P^ef by multiplying the rotation angle 
error P^ by the proportion gain parameter Kpp (step SP4). 

The CPU 148 then computes the rotation speed V^^ of the output 
axis 106 by differentiating the rotor axis magnetic pole rotation 
angle P^^^ stored in the register 129 (step SP5) , and computes the 
speed error Ve by subtracting the rotation speed V^^^ computed in 
step SP5 from the target rotation speed Vj^^^f computed in step SP4 
(step SP6) . . 

Then, the CPU 148 sequentially multiplies the speed error Ve 
by the speed integration gain obtained by the following Equation 
(7) and the proportion gain K^p (step SP7 and step SP8).. 



S + Kvi 



(7; 



Thus, the target rotation torque Tq can be obtained. 
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When the rotation speed V^^^ is provided from the sub-control 
units 73A through 73D in the motor rotation control operation 
process mode, the CPU 148 starts the process from the step SPG. 
When the specified rotation torque T^^f is provided, it' is stored 
in the register 12 9 as the target rotation torque Tq. 
(2-3-2) Process of CPU 148 in the serial communications process 
mode 

The CPU 14 8 communicates with the sub-control units 73A 
through 73D in the serial communication process mode, inputs a 
control command and a change parameter from the sub-control units 
73A through 73D, or transmits the internal monitor signal to the 
sub-control units 73A through 73D. 

(2-4) Relationship between coil drive current and output torque 

Described below is the relationship between the drive 
currents 1^, Iv. and I„ to be applied to each of the coils 99A 
through 99F in the U, V, and W phases of the motor unit 90 in the 
motors M-1 through M-14 with the above described configuration', 
and the rotation torque (hereinafter referred to as an output 
torque) to be externally output through the output axis 106. 

When the density of the crossing magnetic fluxes of each of 
the coils 99A through 99F in the U, V, and W phases obtained when 
the drive currents I^, 1^/ and are applied to each of the coils 
99A through 99F in the U, V, and W phases is defined as <|)u, (t)v, 
~aTid~(l)w; the outpuir~"torque T~~(9~) i"s~olDta:ilTed~by"1:he~fmr^^^^ 
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Equation (8) using the magnetic pole angle 0p of the rotor axis 94 
of the motor unit 90. 



T(9p) = lu X (|)u X KO + Iv X (t)v X KO + Iw X (j)w X KO 



(8) 



o 

SSI, 

01 

m 



In the Equation (8) above, KO indicates a constant 
coefficient obtained when the drive currents 1^, I^, and I^ are 
applied to each of the coils 99A through 99F. 

The drive currents 1^, Ivf and I„ to be applied to each of the 
coils 99A through 99F in the V, and W phases are controlled as 
shown by the following Equations (9), (10), and (11). 



lu = 10 X sin 0p 



(9) 



O 



Iv = 10 X sin 



ep 



271 

3 



(10) 



Iw = 10 X sin 



0p 



271 



(11) 



Each of the magnetic flux density ^u, ^v, and <|)w is computed 
as follows. 



<|>u = (|)0 X sin 9p 



(12) 
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(|)v = <|)0 X sin 



9p + — 

3 



(13) 



(|)w = (t)0 X sin 



_ 2k 

ep-- 



(14) 



03 



Accordingly, the output torque T (Gp) • is obtained by 
substituting the Equations (9) through (14) in the Equation (8) as 
represented by the following Equation (15) . 



T(0p) 

= 10 X <|)0 X KO{sin 6p x sin 9p 

... (15) 



« 


+ sin 


ep + 


2k' 

3 . 


X sin 


Gp + 


27C" 

3 _ 




+ sin 


ep - 


27l" 

3 _ 


X sin 


ep - 


27t" 

3 _ 



= 10 X 4)0 X Kl (where, Kl = 1 . 5K0) 



Therefore, in the motors M-1 through M-14, an output torque 
proportional to the level of the drive currents 1^, Iv^ ^r^d 1^ to 
be applied to each of the coils 99A through 99F can be obtained. 
(3) Unleveled Ground Walking Control Process 

In addition to the above described configuration, the sub- 
control unit 73D of each of the leg units 14A and 14B of the robot 

-1-0— i-s de s-i-gn e d— to- p e r f o r m— an- un-l-e vel-e d— ground— wa 1 king- c on t-r o-l- 

process for controlling each of the motors M-13 and M-14 of the 
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ankle joint mechanism 43 such that the robot 10 can correctly walk 
while keeping balance even on the unleveled ground. 

In this case, the unleveled ground walking control process 
can be performed by controlling the rotation of each of the motors 
M-13 and M-14 of the ankle joint mechanism 43 to allow the reverse 
surface of the foot unit 44 on the walkway to follow the tilt or 
the convexity/concavity surface of the walkway (control the tilt 
of the foot unit based on the tilt or the convexity/concavity ' of 
the walkway) , The control can be performed by controlling the 
rotation of each of the motors M-13 and M-14 such that the 
external force applied to the output axis 106 (Fig. 9) of each of 
the motors M-13 and M-14 of the ankle joint mechanism 43 can be 
constantly ' 0 . ' 

In the sub-control unit 73D of each of the leg units 14A and 
14B, the above described unleveled ground walking control is 
performed on each of the motors M-13 and M-14 of the ankle joint 
mechanism 43 in the unleveled ground walking controlling procedure 
RTl shown in Fig. 22 each time a target rotation angle of each of 
the motors M-9 through M14 is provided from the main control unit 
70 (Fig. 7) at the first time intervals in the walking operation*. 

That is, when the main control unit 70 provides a target 
rotation angle of each of the motors M-13 and M-14 of the ankle 
joint mechanism 43 for* the sub-control unit 73D of each of the leg 
uni"ts^"r47^ an^~r^^^ th"e" sub^contror~unit^ 7 3D— starts— the— un^reve-l-ed— 
ground walking controlling procedure RTl in step SPIO, and then. 



in step SPll, computes the specified rotation angle, the specified 
rotation speed, or the specified rotation torque of each of the . 
motors M-13 and M-14 for 1 [ms] which is a control cycle of each 
of the motors M-13 and M-14 based on the target rotation, angle of 
each of the motors M-13 and M-14 of the ankle joint mechanism 43 
preliminarily provided by the main control unit 70, and the target 
rotation angle of each of the motors M-13 and M-14 newly provided 
by the main control unit 70. 

Accordingly, when a target rotation angle of each of the 
motors M-13 and M-14 is provided from the main control unit 70 to 
the sub-control unit 73D every 0.5 second, the specified rotation 
angle, the specified rotation speed, or the specified rotation 
torque of each of the motors M-13 and M-14 for 1 [ms] is computed 
50 times in time series. 

In step SPll, the sub-control unit 73D resets to '0' the 
count value indicating the order (that is, the order of the 
specified rotation angle, the specified rotation speed, or the 
specified rotation torque in the 50 time series 'data) of the 
specified rotation angle, the specified rotation speed, or the 
specified rotation torque being counted in an internal counter. 

Then, in step SP12, the sub-control unit 73D increases the 
count value of the internal counter by 1. Then, control is passed 
to step SP13, and the specified rotation angle, the specified 
'r~otatiorr"speed";~ o"f ~the" s"p^l::if i"eid~rat"at"ron~tor'5U^~correspondi-ng^ to — 



the count value is transmitted to each of the motors M-13 and M-14 
of the ankle joint mechanism 43. 

At this time, the first through third drive current detection 
data D3A through D3C (Fig. 19) obtained by digital-converting the 
first through third drive current detection signals S3A through 
S3C (Fig. 18) output from the electric current sensor 71 (Fig. 18) 
of each of the coil drive blocks 140A through 140C (Fig. 18) of 
the power substrate 112 (Fig. 18) in the first analog/digital 
conversion circuit 133 of the one-chip microcomputer 115 (Fig, 19) 
is provided from the motors M-13 and M-14 to the sub-control unit 
73D through the communications with each of the motors M-13 and M- 
14 of the ankle joint mechanism 43. 

Thus, the sub-control unit 73D fetches the first through 
third drive current detection data D3A through D3C from each of 
the motors M-13 and M-14 in step SP14, then computes the output 
torque of each of the motors M-13 and M-14 of the ankle joint 
mechanism 43 based on the first through third drive current 
detection data. D3A through D3C in step SP15. 

Furthermore, in step SP16, the sub-control unit 73D computes ^ 
the torque (hereinafter referred to as an external force torque Tf) 
generated on the output axis 106 of each of the motors M-13 and M- 
14 by an external force by subtracting the preliminarily stored 
torque Tg generated by their weights when they are formed on the 

out"pu"tr"axTs~rO"6 oT~each"^o"'f~the'^m'at"ox"s^^M^l~3— and~M^^ — 

output torque T^. 
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In addition, in step SP17, the sub-control unit 73D 
determines for each of the motors M-13 and M-14 whether or not the 
computed value of the external force torque is 'O.V 

Obtaining an affirmative result in step SP17 indicates, for 
example, the foot unit 44 does not touch the ground or the reverse 
surface of the foot unit 44 touches the ground as following the 
tilt or the concavity/convexity of the walkway. At this time, the 
sub-control unit 74D returns to step SP12, and performs the 
processes in and after step SP2 for 1 [ms] . 

On the other hand, obtaining a negative result in step SP17 
indicates that the reverse surface of the foot unit 44 touches the 
ground as not following the tilt or the concavity/ convexity of the 
walkway. At this time, the sub-control unit 74D amends the next 
specified rotation angle, the specified rotation speed, or the 
specified rotation torque to be supplied .for each of the motors M- 
13 and M-14 in step SP18 such that the value of the external force 
torque provided for the output axis 108 of the motors M-13 and 
M-14 can reach '0,' then returns to step SP12, and then performs 
the processes in and after step SP2 for 1 [ms] . 

Thus, the robot 10 can correctly walk while keeping good 
balance even • on the unleveled ground by the sub-control unit 73D 
of each of the leg units 14A and 14B amending the specified 
rotation angle, the specified rotation speed, or the specified 
r o tatd-on— to r qu e— t o— b e— s uppd-i-e d— f o r — the— mo t o r s— M-d-3— and— M--t 
ankle joint mechanism 43 as necessary. 



(4) Operation and Effect of the Present Embodiment 

With the above described configuration, when the robot 10 is 
walking, the rotation of the motors M-13 and M-14 is controlled 
such that the external force torque applied to the output axis 
106 of each of the motors M-13 and M-14 of the ankle joint 
mechanism 43 of each of the leg units 14A and 14B can be 
constantly '0.' 

Therefore, with this robot 10, the reverse surface of the 
foot unit 44 can follow even the unleveled ground having tilt and 
convexity/concavity, thereby realizing a walk with good balance. 
Thus, the robot 10 can omit various sensors for the conventional 
unleveled ground walking control. 

In addition, since the robot 10 contains the control 
substrate 111 and the power substrate 112 for drive-controlling 
the motor unit 90 in each of the motors M-1 through M-14, all 
motors M-1 through M-14 can be connected to each of the sub- 
control units 73A through 73D through a total of 7 cables as shown 
in Fig. 8, thereby reducing the number of wires connected to the 
entire robot. 

Furthermore, since the robot 10 has the configuration shown 
in Fig. 9 in which the motor unit 90 and the torque amplification 
unit 91 are stored as compactly incorporated as each of the motors 
M-1 through M-14, the configuration of each joint mechanism (the 

wa"i"st ~j"o"int"'mechan"i~sm~227~the~n"eck -j-o±nt~mechan^^ 2-67 — the 

shoulder joint mechanism 29, the elbow joint mechanism 32, the 



thigh joint mechanism 36, the knee joint mechanism 41, and the 
ankle joint mechanism 43) can be simpler than the configuration in 
which the motor unit 90 and the torque amplification unit 91 are 
mounted independent of each other, thereby realizing a small joint 
mechanism (and the robot 10) . 

With the above described configuration, the two-leg walking 
robot 10 can follow even the unleveled ground having tilt and ^ 
convexity/concavity by controlling the rotation of the motors M-13 
and M-14 such that the external force torque Tg applied to the 
output axis 106 of each of the motors M-13 and M-14 of the ankle 
joint mechanism 43 of each of the leg units 14A and 14B can be 
constantly '0' in the walking operation, thereby realizing a walk 
with good balance. Thus, various sensors used in the conventional 
unleveled ground walking control can be omitted, thereby realizing 
a robot having a simple configuration. 

In addition,, since the robot 10 contains the control 
substrate 111 and the power substrate 112 for drive-controlling 
the motor unit 90 in the motors M-1 through M-14, thereby reducing 
the number of wires in the entire robot and realizing a robot 
having a simpler configuration, 
(5) Other Embodiments 

According to the above described embodiments, the present 
invention is applied to a two-leg walking robot 10. However, the 

p"r es"enir "1 n ven ti"on^ — but— can— be 

widely applied to various robots. In this case, the invention 



relating to the control of a joint mechanism can be widely applied 
to a four-leg walking robot and other robots with the number of 
legs other than two or four. In addition, the invention including 
a motor control unit as a drive unit for each of the joint 
mechanism in a motor unit can also be widely applied to various 
robots other than walking robots. 

In the above described embodiments, the invention relating to 
the control of a joint mechanism is applied to the ankle joint 
mechanism 43 connecting the lower leg unit as the first link 
(first component) of the leg units 14A and 14B to the foot unit 44 
as the second link (second component) . However, the present 
invention is not limited to this application, but can be widely 
applied to various units other than the ankle joint mechanism 43, 
for example, to a wrist joint, etc. 

Furthermore, in the above described embodiments, the electric 
current sensor 71 is made of the coil mounted as shown in Fig. 18 
as an electric current detection unit .for detecting the drive 
currents 1^,1^, and I^ (shown in Fig. 18) -of the motors M-1 
through M-14. However, the present invention is not limited to 
this application, but can be widely applied to various 
configurations depending on the configuration of the applicable 
actuator. 

In addition, according to the above described embodiments, 

Th^"fuh^iri"orr^f"ajr"ex"t 

the external torque (external force torque T^) applied to the 



output axis 106 of the motors M-13 and M-14 based on the drive 
currents I^, 1^/ and (Fig. 18) of the motors M-13 and M-14 
detected by the electric current sensor 71 (Fig. 18) is assigned 
to the sub-control unit 73D of each of the leg units 14A and 14B. 
However, the present invention is not limited to this application, 
but the function can be assigned to the arithmetic operations 
block 128 (Fig. 19) in the motors M-13 and M-14. 

Furthermore, according to the above described embodiment, the 
control substrate 111 and the power substrate 122 are configured 
as shown in Figs. 17 through 21 as motor control units for drive- 
controlling the motor unit 90 of each of the motors M-1 through M- 
14 configured as shown in Fig. 9. However, the present invention 
is not limited to this application, but various configurations can 
be widely applied. 

Industrial Applicability 

The present invention can be applied to a two-leg ' walking 
robot or other walking robots. 



